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Abstract. A method of estimating the mass, the location of center of mass, and 
the moments of inertia of each rigid body link of a robot during general manip- 
ulator movement is presented. The algorithm is derived from the Newton-Euler 
equations, and uses measurements of the joint torques as well as the measurement 
and calculation of the kinematics of the manipulator while it is moving. The iden- 
tification equations are linear in the desired unknown parameters, and a modified 
least squares algorithm is used to obtain estimates of these parameters. Some of the 
parameters, however, are not identifiable due to the restricted motion of proximal 
links and the lack of full force/ torque sensing. The algorithm was implemented on 
the MIT Serial Link Direct Drive Arm. A good match was obtained between joint 
torques predicted from the estimated parameters and the joint torques computed 
from motor currents. 
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1 Introduction 

This paper presents a method of estimating all of the inertial parameters, the 
mass, the center of majss, and the moments of inertia of each rigid body link of a 
robot manipulator using joint torque sensing. Determining these parameters from 
measurements or computer models is generally difficult and involves some approxi- 
mations to handle the complex shapes of the arm components. Typically, even the 
manufacturers of manipulators do not know accurate values of these parameters. 

The degree of uncertainty in inertial parameters is an important factor in judg- 
ing the robustness of model-based control strategies. A common objection to the 
computed torque methods, which involve full dynamics computation (e.g., Luh, 
Walker, and Paul, 1980), is their sensitivity to modelHng errors, and a variety of 
alternative robust controllers have been suggested (Samson, 1983; Slotine, 1984; 
Spong, Thorp, and Kleinwaks; 1984, Gilbert and Ha, 1984). Typically these robust 
controllers express modelling errors as a differential inertia matrix and coriolis and 
gravity vectors, but in so doing, no rational basis is provided for the source of er- 
rors or the bounds on errors. The error matrices and vectors combine kinematic 
and dynamic parameter errors, but kinematic calibration is sufficiently developed 
so that very little error can be expected in the kinematic parameters (Whitney, 
Lozinski, and Rourke , 1984). 

One aim of this work is to place similar bounds on inertial parameter errors by 
explicitly identifying the inertial parameters of each link that go into the making of 
the inertia matrix and coriolis and gravity vectors. Our work in load identification 
(Atkeson, An, and Hollerbach, 1985) suggests, for example, that mass can be accu- 
rately identified to within 1%. Therefore, an assumption of 50% error in link mass 
in verifying a robust control formulation (Spong, Thorp, and Kleinwaks, 1984) is an 
unreasonable basis for argument. Slotine (1984) suggests that errors of only a few 
percent in inertial parameters make his robust controller superior to the computed 
torque method, but it may well be that these parameters can be identified more 
accurately than his assumptions. 

As an alternative approach we propose estimating the inertial parameters on the 
basis of direct dynamic measurements. The same algorithms used to identify load 
inertial parameters (Atkeson, An, and Hollerbach, 1985) can be modified to find 
link inertial parameters of a robot arm made up of rigid parts. The Newton-Euler 
dynamic equations are used to express the measured forces and torques at each 
joint in terms of the product of the measured movements of the rigid body links 
and the unknown link inertial parameters. These equations are linear in the inertial 
parameters. However, unlike load estimation, the only sensing is one component 
of joint torque, inferred from motor current. Coupled with restricted movement 
near the base, it is, therefore, not possible to find all the inertial parameters of the 



proximal links. As will be seen, these missing parameters have no effect on the 
control of the arm. 

In this paper, manipulators with only revolute joints are discussed since handling 
prismatic joints requires only trivial modifications to the algorithm. The proposed 
algorithm was verified by implementation on the MIT Serial Link Direct Drive Arm. 

1.1 Previous Work 

Mayeda, Osuka, and Kangawa (1984) required three sets of special test motions to 
estimate the coefficients of a closed-form Lagrangian dynamics formulation. The 10 
inertial parameters of each link are lumped into these numerous coefficients, which 
are redundant and susceptible to numerical problems in estimation. On the other 
hand, every coefficient is identifiable since these coefficients represent the actual 
degrees of freedom of the robot. By sensing torque from only one joint at a time, 
their algorithm is more susceptible to noise from transmission of dynamic effects of 
distant links to the proximal measuring joints. For efficient dynamics computation, 
the recursive dynamics algorithms require the link parameters explicitly. Though 
recoverable from the Lagrangian coefficients, it is better to estimate the inertial 
parameters directly. Though this algorithm was implemented on a PUMA robot, 
it is difficult to interpret the results because of dominance of the dynamics by the 
rotor inertia and friction. 

Mukerjee (1985) directly applied his load identification method to link identi- 
fication, by requiring full force-torque sensing at each joint. Instrumenting each 
robot Hnk with full force-torque sensing seems impractical, and is actually unnec- 
essary given joint torque sensing about the rotation axis. Partially as a result, he 
does not address the issue of unidentifiability of some inertial parameters. Also, he 
did not verify his algorithm by simulation or by implementation. 

Olsen and Bekey (1985) presented a link identification procedure using joint 
torque sensing and special test motions with single joints. The unidentifiability 
of certain inertial parameters was not resolved, and the least squares estimation 
procedure written as a generaHzed inverse would fail because of linear dependence of 
some of the inertial parameters. Again, their procedure was not tested by simulation 
or by actual implementation on a robot arm. 

Neuman and Khosia (1985) developed a hybrid estimation procedure combining 
a Newton-Euler and a Lagrange-Euler formulation of dynamics. Simulation results 
for a three degree-of-freedom cylindrical robot were presented, and the unidentifi- 
ability of certain inertial components was addressed. For some reason they state 
link mass must be known for a linear estimation procedure, but such a restriction 
does not exist with our method. Though planning to work with the CMU DDArm 
II, they have not yet presented experimental results. 
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Figure 1: Coordinate origins and location vectors for link identification. 

2 ESTIMATION PROCEDURE 



2.1 Formulation of Newton-Euler Equations 

In our work in load identification (Atkeson, An, and Hollerbach, 1985), the Newton- 
Euler equations for a rigid body load were formulated to be linear in the unknown 
inertial parameters. Then simple linear least squares method was used to estimate 
those parameters. By treating each link of a manipulator as a load, this formulation 
can be extended to the link estimation problem. The differences in the equations 
are that only one component of force or torque is sensed and that the forces and 
torques from distal links are sunmied and transmitted to the proximal joints. 

Consider a manipulator with n joints (Figure 1). Each link i has its own local 
coordinate system P^ fixed in the link with its origin at joint i. The joint force and 
torque due to the movement of its own link can be expressed by simply treating the 
link as a load and applying the previously developed equations for load identification 
(Atkeson, An, and Hollerbach, 1985): 
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or more compactly, 
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where w,j is the wrench (vector offerees and torques) at joint i due to movement of 
link j alone. A,- is the kinematic matrix that describes the motion of link i and <^,- is 
the vector of unknown link inertial parameters. All of the quantities are expressed 
in the local joint i coordinate system. The formulation of the above Newton-Euler 
equations were already presented in the load identification paper (Atkeson, An, and 
Hollerbach), and are summarized in the Appendix of this paper for a reference. 

The total wrench w,- at joint i is the sum of the wrenches Wij for all links j 
distal to joint i: 
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Each wrench w»y at joint i is determined by transmitting the distal wrench Wjj 
across intermediate joints. This is a function of the geometry of the linkage only. 
The forces and torques at neighboring joints are related by 
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R,= the rotation matrix rotating the link z + 1 coordinate system to the link i 

coordinate system, 
s,= a vector from the origin of the Hnk i coordinate system to the link z + 1 co- 
ordinate system, and 



T,-=: a wrench transmission matrix. 

To obtain the forces and torques at the i*^ joint due to the movements of the 
j^^ link, these matrices can be cascaded: 






(5) 



where \Jij = TtT,^.! • • • TjA,- and U,-,- = A,-. A simple matrix expression for a serial 
kinematic chain (in this case a six joint arm) can be derived from (2) and (5): 



(6) 



This equation is linear in the unknown parameters, but the left side is composed 
of a full force-torque vector at each joint. Since only the torque about the joint 
axis can usually be measured, each joint wrench must be projected onto the joint 
rotation axis (typically [0, 0, 1] in internal coordinates) , reducing (6) to 
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where r,- = [0,0,0, 0,0, Ij-w,- is the joint torque of the z*'' link, V' = [^i, 02 5<^3? <^45 05? <^e 
and Kij = [0, 0, 0, 0, 0, l] • XJ,j- when the corresponding entry in (6) is nonzero. For 
an n-link manipulator, r is a n x 1 vector, V is a lOn x 1 vector, and K is a n x lOn 
matrix. 

2.2 Estimating the Link Parameters 

Equation (7) represents the dynamics of the manipulator for one sample point. For 
extra data, (7) is augmented as: 
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Unfortunately, one cannot apply simple least squares estimate: 
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because K^K is not invertible due to loss of rank from restricted degrees of freedom 
at the proximal links and the lack of full force-torque sensing. 

There are several ways to resolve this problem. One way to resolve this problem 
is to use the pseudo inverse to get a solution ^ to t = KV'. But since K is a 
potentially large nN x lOn matrix, the pseudo-inverse is computationally inefficient. 
Another simple method similar to the pseudo inverse is to use ridge regression 
(Marquardt and Snee, 1975). Ridge regression makes K^K invertible by adding a 
small number to the diagonal elements: 

V'=(K^K + rfIio„)-'K^r (9) 

The estimates are nearly optimal if d << A^,„(K^K), where A^,„ is the smallest 
non-zero eigenvalue of K^K. Other methods of solution, fundamentally different 
from the above two, are presented in the discussion section. 

3 Experimental Results 

Link estimation was implemented on the MIT Serial Link Direct Drive Arm (Figure 
2), a three link serial manipulator with no transmission mechanism between the 
motors and the links. The ideal rigid body dynamics is a good model for this arm, 
uncomplicated by joint friction or backlash typical of other manipulators. Hence the 
fidelity of this manipulator's dynamic model suits estimation well. The coordinate 
system for this arm is defined in Figure 3. A set of inertial parameters is available 
for the arm (Table 1), determined by modeling with a CAD /CAM database (Lee, 
1983). These values can serve as a point of comparison for our method, but they 
may not be accurate because of modeling errors. 

The motors are rated at 660 Nm peak torque for joint 1 and 230 Nm for joints 
2 and 3 (Asada and Youcef-Toumi, 1984). Joint 1 is presently capable of an an- 
gular acceleration of 1150 deg/sec^, joints 2 and 3 in excess of 6000 deg/sec^. In 
comparision, joint 1 of the PUMA 600 has a peak acceleration of 130 deg/sec^ and 
joint 4 at the wrist 260 deg/sec^. Joint position is measured by a resolver and joint 
velocity by a tachometer. The tachometer output is of high quality and leads to 
good acceleration estimates after differentiation. The accuracy of the acceleration 
estimates plus high angular accelerations greatly improves inertia estimation. 

The joint torques are computed by measuring the currents of the 3 phase wind- 
ings of each motor (Asada, Youcef-Toumi, and Lim, 1984). For the three phase 
brushless permanent magnet motors of the direct drive arm, the output torque is 
related to the currents in the windings by: 

T = Krila sin 6 + h sin(^ + 120) + Ic sin(^ + 240)) (10) 
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Figure 2: The MIT Serial Link Direct Drive Arm 
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Figure 3: The link coordinate system. 
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The torque constant Kt for each motor is caHbrated statically by measuring the 
force produced by the motor torque at the end of a known lever arm. The force 
is measured using a BarryWright Company Astek FS6-10A-200 6-axis force/torque 
sensor. Asada, Youcef-Toumi, and Lim have found that for a motor similar to 
the motors of our manipulator, the torque versus current relationship was non- 
linear, especially for small magnitudes of torques, and also varied as a function of 
the rotor position. However, for the results presented in this paper, the nonlinear 
effects were ignored since substantial portions of the movements in the experiments 
required large magnitudes of torques. Since the least squares algorithm minimizes 
the square of the error, torque errors for torques of small magnitudes do not affect 
the estimates very much. 

For the estimation results presented, 600 data points were sampled while the 
manipulator was executing 3 sets of fifth order polynomial trajectories in joint 
space. The specifications of the trajectories were: 

1. (330, 289.1, 230) to (80, 39.1, -10) degrees in 1.3s, 

2. (330, 269.1, -30) to (80, 19.1, 220) degrees in 1.3s, 

3. (80, 269.1, -30) to (330, 19.1, 220) degrees in 1.3s, 

Since K^K in (9) is singular, estimates for the 30 unknowns are com.puted by adding 
a small number [d = 10.0 << A^,„(K^K) = 3395.0) to the diagonal elements of 
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67.13 


53.01 


19.67 


mCx(Kg • m) 


0.0 


0.0 


0.3108 


mCy 


2.432 


3.4081 


0.0 


mCg 


35.8257 


16.6505 


0.3268 


h.(Kg'm'') 


23.1568 


7.9088 


0.1825 


Ixy 


0.0 


0.0 


0.0 


hz 


-0.3145 


0.0 


-0.0166 


^yy 


20.4472 


7.6766 


0.4560 


lyz 


-1.2948 


-1.5036 


0.0 


hz 


0.7418 


0.6807 


0.3900 



Table 1: CAD-modeled inertial parameters. 



K^K. 

Typical results, obtained using ridge regression method, are shown in Table 2. 
Parameters that cannot be identified because of constrained motion near the base 
are denoted by 0.0* . The first nine parameters of the first link are not identifiable 
because this link has only one degree of freedom about its z axis. These nine 
parameters do not matter at all for the movement of the manipulator and thus can 
be arbitrarily set to 0.0. 

Other parameters marked by (f) can only be identified in linear combinations, 
indicated explicitly in Table 3. The ridge regression automatically resolves the 
linear combinations in a least squares sense. It can be seen that the estimated sums 
roughly match the corresponding sums inferred from the CAD-modeled parameters, 
but the sizeable discrepancy indicates that one parameter set may be more accurate 
than the other. 

To verify the accuracy of the estimated and the modeled parameters, the mea- 
sured joint torques are compared to the torques computed from the above two 
sets of parameters using the measured joint kinematic data. As shown in Figure 
4, the estimated torques match the measured torques very closely. The torques 
computed from the CAD /CAM modeled parameters do not match the measured 
torques as closely. This comparison verifies qualitatively that for control purposes 
the estimated parameters are in fact more accurate than the modeled parameters. 
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J-xy 
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hz 
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Table 2: Estimated inertial parameters. 



Linear Combinations 


Estimated 


CAD-Modeled 


^3Czj2 + Ivz2 


-1.0589 


-1.3565 


J-xxz ~ ^yyz 


-0.3691 


-0.2702 


^ZZ-i 1 i-XXz 


0.7082 


0.8632 


Izzi + ^xx2 + Ixxs + rnsll 


15.7029 


12.8169 


J-XX2 ' ■'xxs ■'1/1/2 


0.4709 


0.4147 


msc^g — m2Cy^ 


-1.6863 


-3.0814 



Table 3: Parameters in linear combinations {I2 = 0.45m.) 
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Figure 4: The measured, CAD-modelled, and the estimated joint torques 
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4 Discussion 

Good estimates of the link inertial parameters were obtained, as determined from 
the match of predicted torques to measured torques. The potential advantage 
of this movement-based estimation procedure for increased accuracy as well as 
convenience was demonstrated by the less accurately predicted torques based on 
the CAD-modeled inertial parameters. 

There are three groups of inertial parameters: fully identifiable, completely 
unidentifiable, and identifiable in linear combinations. Membership of a parameter 
in a group depends on the manipulator's particular geometry. Some link inertial 
parameters are unidentifiable because of restricted motion near the base and the 
lack of full force-torque sensing at each joint. For the first link, rotation is only 
possible about its z axis. Suppose full force-torque sensing is available at joint 1. 
It can be seen from (1) that /xx^, /xyj, and lyy^ are unidentifiable because they have 
no eff"ect on joint torque. Since the gravity vector is parallel to the z axis, c^^ is 
also unidentifiable. If it is now supposed that only torque about the z axis can be 
sensed, then all inertial parameters for link 1 become unidentifiable except I^z^ . 

In a multi-link robot a new phenomenon arises. Some parameters can only be 
identified in Hnear combinations, because proximal joints must provide the torque 
sensing to identify fully the parameters of each link. Certain parameters from 
distal links are carried down to proximal links until a link appears with a rotation 
axis oriented appropriately for completing the identification. In between, these 
parameters appear in linear combinations with other parameters. This partial 
identifiability and the difficulty of analysis become worse as the number of links are 
increased. 

The ridge regression automatically resolves the linear combinations in a least 
squares sense, which make these inertial parameters appear superficially different 
from those derived by CAD modeling. An alternative method is generation and 
examination of the closed-form dynamics, which is a complex procedure for more 
than two degrees of freedom. 

A second alternative is a numerical analysis via singular value decomposition of 
K in (8), yielding (Golub and Van Loan, 1983) 

K = USV^ 

where D = diag{cr,} and U and V^ are orthogonal matrices. For each column 
of V there corresponds a singular value cr,- which if not zero indicates that linear 
combination of parameters, vf V, is identifiable. Since K is a function only of the 
geometry of the arm and the commanded movement, it can be generated exactly 
by simulation rather than by actually moving the real arm and recording data with 
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inevitable noise. 

The above two rocedures isolate several sets of parameters whose linear combi- 
nations within each set are identifiable. Then we can arbirtrarily set all but one 
of the parameters of each set to zero and apply the estimation algorithm for the 
reduced set of fully identifiable parameters. As shown in Table 2, for our 3 link 
manipulator, these two procedures result in grouping the 30 inertial parameters 
into the following categories: 

1. fully identifiable: rrisc^^, rrisCy^, I^y^, I^^^, I^^^, /^^3, rrizc^^, hy^, h^ 

2. completely unidentifiable: mj, rriiC^, mi, mic^,, mic^,, rriic^^, /^^,, 7^^,, /^^^, 

3. identifiable in linear combinations: ms, m^c^^ I^^^, lyy^, niiCy^, h^,, lyy^, ly,. 

The completely unidentifiable parameters can be arbitrary set to zero. For the 
linear combination parameters, the combinations of these parameters that can be 
identified together are shown in table 3. To obtain a particular solution for these 
parameters, one can set rriz.mzc^^j^^^, and I^^^ to zero. Then, the remaining 6 
parameters of this category can be treated as fully identifiable parameters along 
with the 9 parameters in the first category. Those colunms of K which correspond 
to the 15 zeroed parameters are taken out, reducing K^K to a 15 x 15 full rank 
matrix. Now, simple least squares can be applied to estimate the 15 identifiable 
parameters. For our implementation experiments, the results of this method agreed 
with the results of ridge regression presented in the previous section. 

Although not as simple as the ridge regression method, these methods are attrac- 
tive since it allows us to reformulate the dynamics in terms of only the identifiable 
parameters. This then can increase the efiiciency of the corresponding inverse dy- 
namics computation for controller implementations (HoUerbach and Sahar, 1983). 
We are still investigating these issues with eventual goals of studying the effec- 
tiveness of different control algorithms using the estimated dynamic model and 
analyzing their robustness with modelling errors. 
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APPENDIX 

Beginning with an n-joint manipulator, we assume each link i has a local coordinate 
system P,- with origin fixed at joint i\ the vector p,- locates P,- with respect to a 
global coordinate system O (Figure 1). At the center of mass, a coordinate system 
Q,- is aligned with the principle axes of inertia. The center of mass is located with 
respect to P,- by the vector c,- and with respect to the global origin O by q,. 

The inertial parameters of mass, center of mass, and moment of inertia are 
related to the motion of link i by the Newton-Euler equations: 

q^i = f« + m.g = m,q.- (H) 

qXii = Uii - Ci X fii = qliUi + w,- X (,I,a;.) (12) 

where 

qfi = the net force acting on link i, 

^n,- = the net torque about the center of mass of link i, 

fij = the force at joint i due to motion of link j alone, 

n,j = the torque at joint i due to motion of link j alone, 

m,- = the mass of link i, 

qli = the moment of inertia about the center of mass, 

<jJi = the angular velocity vector, and 

g = the gravity vector (g = [0, 0, -9.8 m/sec^]). 

Although the location of the center of mass and hence its acceleration q, are 
unknown, the latter is related to the acceleration p,- of joint i by (Symon, 1971): 

q,- = Pt + Ui X Ci + (Ji X (ui X c,) (13) 

Substituting into (11), which then substitutes into (12), 

fa = rrii (p,- - g) + w,- x m,c,- + w.- x (w,- x m,c») (14) 

n,t = (g - p,) xm,Ct + qliUi + mci x (ui x cA 

(15) 
-hUiX{qIiUi) + m,c,- X {Ui X (cji X c,)) 

Although the terms c,- x (w.- x c.) and c» x (a;,- x (a;,- x c.)) are quadratic in the 
unknown location of the center of mass c,-, they may be eliminated by expressing 
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the moment of inertia tensor about the joint i origin pi,- instead of about the center 
of mass qli. By the parallel axis theorem (Symon, 1971), 



pi.- = ,1.- + m.[(cf c.)l - (c.cf )] 



(16) 



where 1 is the 3 dimensional identity matrix. Rewriting (15) and using (16), 

n.f = (g - P.) X rma+gliUi + mil(cfci)l - (c.cf )]d;i 

-^Ui X (qIiUi)+Ui X (m.[(cf c.)l - (Cic'[)]ui) (17) 

= (g - Pt) X miCi-\-pIiUi + Ui X (pliUi) 

The following notation aids formulating a system of linear equations from those 
above: 

—Ljg a;, 

w, 



w X c = 



'V 

— (JJV W-B 



Cz 



= [ux] c 



Iu = 



OJx (^y (^z 

(jJx Uy OJz 

CJa; Wy CJ^ 





■ixx 






ixz 




-'xy 






■'xy 




/xz 

■'vv 


A 


•w] 


/xz 




^V. 






Iv> 




. ^- . 






J" . 



where 



I = I^ = 

A matrix equation can then be written from (14) and (17): 



J-xx J-xy J-xz 

-'xy ^yy ^yz 

L ^xz ^yz ^zz . 



n„ 



Pt-g [a;.-x] + [a;.-x][a;.-x] 

. [(g-Pt)xl [•a;.-] + [a;iX][«a;4 



rrii 
rriiCx. 
rriiCy. 

-'xx,- 
^xyi 

^XZi 

^yvx 
^yzi 

^ZZi 
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